1. Introduction : 

Le filtre de Kalman a ete applique avec succes aux problemes de navigation depuis son apparition 
en 1961 [2], il a I'avantage d'avoir un gain adaptatif qui est mis a jour a chaque periode de balayage 

du Radar. Cependant, le choix du modele de mouvement reste un probleme, car en effet, le modele 
de mouvement d'une cible qui se deplace a vitesse constante est different de celui de la cible qui 
manoeuvre. Dans cette partie nous allons appliquer le filtre de Kalman au mouvement d'une cible 
qui se deplace a acceleration constante. 

2. Outils de simulation : 

C'est un « noyau dur » d'un logiciel de mathematiques specialement etudie pour traiter des 
matrices. Un langage de programmation specifique permet de realiser des simulations numeriques 
basees sur des algorithmes d'analyse numerique. II pent done etre utilise pour la resolution 
approchee d'equations differentielles, d'equations aux derivees partielles ou de systemes lineaires, 
etc... 

On a choisi d'utiliser le langage MATLAB pour les raisons suivantes: 

> L'association du calcul et de la visualisation qui permet de tester en ligne ses 
modifications. 

> La possibilite d'incorporer directement les figures dans un traitement de texte de type 
Word. 

> La visualisation des resultats en 2D et 3D. 

Materielles : 

Pour elaborer notre travail nous avons eu besoin d'un Intel Pentiums avec la configuration suivante : 

Intel Pentium 3+1.00 GHz 
RAM 128 Mo 

Systeme d'exploitation : Windows XP. 

3. Probleme pose : 

Le probleme pose est le suivant: 

Nous avons des donnees reelles d'une trajectoire d'un avion qui se deplace, les positions initiates 
nuUes et la vitesse initiate est 121.92 metre /s. 

Le mouvement d'avion ajoute une acceleration lentement variable avec le bruit gaussien suppose 
connu. Ce mouvement affecte cette premiere vitesse. 

Notre objectif consiste a trouver la trajectoire estimee de la cible (I'avion) a travers le filtre de 
Kalman etendu. 



Notre simulation est basee sur le schema-bloc represente dans la figure 2.1. 
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Figure 2.1 : Le schema-bloc de la simulation 



A chaque instant on connait les bruits de mesure done les positions mesurees : 
( la position mesuree = la position reelle + le bruit de mesure) , 

a travers le filtre de Kalman on determine les positions estimees d'ou 1' erreur entre la trajectoire 
mesure et la trajectoire estimee 
(L'erreur d'estimation = la position mesuree - la position estimee) . 

3.1 Les conditions initiales : 

La variance du bruit de processus et la variance de bruit d' observation doivent etre initialement 
specifies. Aussi, I'etat estime et sa co variance doivent etre initialises pour demarrer le processus de 
recurrence du filtre. Pour 1' initialisation, il est important que la matrice de covariance initiale reflete 
reellement 1' incertitude sur I'etat estime initial. 

La consistance de 1' initialisation est necessaire pour une convergence rapide. 

> L'acceleration commandee est une constante 9.81 metre/sec^ 

> la Vitesse initiale est placee a 121 .92 metre /s 

> L'acceleration du bruit d'observation est 1 metre/sec^ 

> L'acceleration du bruit de processus est 0.0001 metre/sec^ 

Maintenant nous initialisons Xg juste comme notre meilleure estimation initiale de la position et la 
Vitesse, et nous initialisons Pq comme I'incertitude dans notre estimation initiale : 

X = [0.00031 0.00030 121.9 121.9] et Pq = 0. 

Alors nous executons les equations du filtre de Kalman une fois par etape. 

4. Presentation du programme : 

L'application est realisee sous MATLAB 6.5. 
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Calcul de : 

• Innovation (residuel) : j^. ^ 

• gain de KALMAN: k^ i 

• matrice de covariance d'innovation : §, . 
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Figure 2.2 : L'organigramme d'estimation du filtre de Kalman 
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5. Les resultats: 

Les resultats de la simulation sont montres sur les figures suivantes : 

Figure 1: Cette figure represente les deux trajectoires obtenues lors de notre simulation. Nous 
avons done la trajectoire reelle et celle estimee en coordonnees cartesiennes. 
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Figure 2.3 : Trajectoire reelle et la trajectoire estimee en coordonnees cartesiennes 



Figure 2: Cette figure represente les deux trajectoires reelle et estimee en coordonnees polaires. 
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Figure 2.4 : Trajectoire reelle et la trajectoire estimee en coordonnees polaires 

(metre/degre) 
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Application du filtre de Kalman 




Figure 3 : Cette figure montre I'erreur entre la trajectoire estimee et la trajectoire mesuree. 
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Figure 2.5 : L'erreur entre la position mesuree et la position estimee 



On remarque que notre trajectoire estime n'est pas tres eloigne de la trajectoire reelle, et que 
I'erreur entre la position estimee et la position mesuree reste relative par rapport au deplacement de 
la cible. 

On remarque aussi que I'erreur n'est pas stable, il varie entre -1200 metre et 400 metre. Ce qui est 
normale parce que le bruit d' observation n'est pas constant. 

6. Conclusion: 

Nous avons presente dans ce chapitre les resultats d' application du filtre de Kalman dans la 
poursuite d'une cible Radar, et nous avons constate que notre filtre est efficace dans ce domaine. 

On peut citer aussi que le filtre de Kalman trouve des applications dans divers secteurs, incluant 
toutes les formes de navigation (espace, air, terre et marin), instrumentation de centrale nucleaire, 
modelisation demographique, fabrication, la detection de metro, radioactivite et logique floue et 
reseaux neuronaux. 
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